Method and system to generate a 3d model for a robot scene

ABSTRACT

A robot is configured to perform a task on an object using a method for generating a 3D model sufficient to determine a collision free path and identify the object in an industrial scene. The method includes determining a predefined collision free path and scanning an industrial scene around the robot. Stored images of the industrial scene are retrieved from a memory and analyzed to construct a new 3D model. After an object is detected in the new 3D model, the robot can further scan the image in the industrial scene while moving along a collision free path until the object is identified at a predefined certainty level. The robot can then perform a robot task on the object.

TECHNICAL FIELD

The present application generally relates to modeling of an industrial scene by a robot, and more particularly, but not exclusively, to constructing a 3D model of an industrial scene with scans taken with a vision sensor associated with a robot.

BACKGROUND

As the field of robotics continues to advance, an increasing amount of focus is placed on the development of technologies that permit a robot to determine collision free pathways and the location of a work piece or other objects in real time. Randomly placed objects within a robot work area or industrial scene can cause interference with certain movements of the robot and prevent work tasks from being completed. Some existing systems have various shortcomings relative to certain applications. Accordingly, there remains a need for further contributions in this area of technology.

SUMMARY

One embodiment of the present application is a unique system and method for generating a real time 3D model of a robot work area or industrial scene. Other embodiments include apparatuses, systems, devices, hardware, methods, and combinations for generating a collision free path for robot operation in an industrial scene. Further embodiments, forms, features, aspects, benefits, and advantages of the present application shall become apparent from the description and figures provided herewith.

BRIEF DESCRIPTION OF THE FIGURES

FIG. 1 is a schematic illustration of a robot system according to one exemplary embodiment of the present disclosure;

FIG. 2 is a schematic illustration of an industrial robot scene according to one exemplary embodiment of the present disclosure;

FIG. 3 is a flowchart directed to a method for generating a scanning path for collision free robot motion according to one embodiment of the present disclosure;

FIG. 4 is a flowchart directed to a method for recognition of an object in the industrial scene;

FIG. 5 is a flowchart directed to a method for generating a 3D model sufficient to reduce ambiguity of the object such that a work task may be performed on an object by the robot;

FIG. 6 is a flowchart directed to a method for improving object recognition and planning a next scanning path for collision free motion so that the robot may perform a task on a detected object; and

FIGS. 7A and 7B define a flowchart directed to a method for improving object recognition, improving grasping confidence and planning a next scanning path for collision free motion.

DETAILED DESCRIPTION OF THE ILLUSTRATIVE EMBODIMENTS

For the purposes of promoting an understanding of the principles of the application, reference will now be made to the embodiments illustrated in the drawings and specific language will be used to describe the same. It will nevertheless be understood that no limitation of the scope of the application is thereby intended. Any alterations and further modifications in the described embodiments, and any further applications of the principles of the application as described herein are contemplated as would normally occur to one skilled in the art to which the application relates.

As the field of robotics continues to advance, an increasing amount of focus is placed on the development of technologies that permit more tightly coupled human-robot interaction (HRI). Application of HRI technologies facilitates robot understanding of information about its surrounding environment and permits an operator to understand or receive feedback about the level of understanding that the robot has attained. Before interaction occurs between an operator and a robot, an initial understanding of the working environment or industrial scene can be obtained. As the robot's understanding of the scene increases, the level of human interaction can decrease (i.e. an operator does not have to program all information into the robot prior to operation which minimizes setup time).

The robot system disclosed herein provides for control methods to retrieve valid information from an industrial scene that can be recognizable by the robot's memory. The control methods enable the robot to obtain information and understanding of elements or objects in the scene while simultaneously optimizing robot motion to perform a task within the industrial scene. This robot path is reactive to variation of the scene and helps the robot to understand the boundaries of the surroundings. The ability for the robot to autonomously retrieve information from the scene facilitates detection of objects, constructive robot motion generation, reduction of time required for overall discovery process and minimizes human involvement in setup and robot programming. Industrial robots can use teach pendants and joy sticks for “jogging a robot” and teaching robot points, however this can be cumbersome, time consuming and dangerous if the operator is in close proximity to the robot while the robot moves through the industrial scene. 3D vision and implicit programming can be used to improve robot path programming by generating a 3D model of an unknown scene around a robot, it takes time to teach the robot to hold a 3D sensor to scan the industrial scene. It can be difficult to manually generate the scanning path to collect sufficient data from the scene and the object without a robot collision and/or incurring reachability problems.

The present disclosure includes methods and systems for automatically generating a complete 3D model of an industrial scene for robotic application that reduces engineering time and cost over manually programming the robot. The methods and systems automatically generate a scanning path to collect sufficient data about the scene and the object location without causing a collision or a reachability problem. The robot scanning system is operably connected to the robot path planning algorithm to the 3D object recognition algorithm so as to provide control input to the robot to perform a task on an object within the industrial scene.

Referring now to FIG. 1, an illustrative robot system 10 is shown in an exemplary working environment or industrial scene. It should be understood that the robot system shown herein is exemplary in nature and that variations in the robot and/or industrial scene is contemplated herein. The robot system 10 can include a robot 12 with a vision system 36 having one or more cameras 38. In one form, one or more of the cameras 38 can be mounted on one of the moveable arms 16 a, 16 b of the robot 12. In other forms, one or more cameras 38 may be positioned apart from the robot 12. A control system 14 including an electronic controller with a CPU, a memory, and input/output systems are operably coupled to the robot 12 and to the vision system 36. The control system 14 is operable for receiving and analyzing images captured by the vision system 36 and other sensor data used for operation of the robot 12. In some forms, the control system 14 is defined within a portion of the robot 12.

The robot 12 may include a movable base 20 and a plurality of movable portions connected thereto. The movable portions may translate or rotate in any desired direction. By way of example and not limitation, movable portions illustrated by arrows 18, 26, 28, 30, 32 and 34 may be employed by the exemplary robot 12. A bin 40 for holding workpieces or other objects 42 to be retrieved and/or worked on by the robot 12 may constitute at least a part of the exemplary industrial scene. An end effector 24 such as a gripping or grasping mechanism or other working tools can be attached to the moveable arm 16 a and used to grasp an object 42 and/or perform other work tasks on the object 42 as desired. It should be understood that the term “bin” is exemplary in nature and as used herein means, without limitation, any container, carton, box, tray or other structure that can receive and/or hold workpieces, parts or other objects. Additional components 44 can be associated with the vision system 36. These components 44 can include lighting systems, reflector(s), refractor(s) and beam expander(s) or the like.

Referring now to FIG. 2, another exemplary industrial scene 50 is illustrated. The vision system 36 is operable with the robot 12 to determine locations of various items within the vicinity of the robot 12. By way of example and not limitation, the scene 50 includes picking bins 60 a, 60 b, potential obstacles 62 a, 62 b and dropping bins 64 a, 64 b. The vision system 36 can be used to determine object location and orientation in the picking bins 60 a, 60 b and/or the dropping bins 64 a, 64 b. The vision system 36 can identify an object inside a picking bin 60 a and transmit a location and orientation of the object to the robot controller 14 (see FIG. 1). The robot controller (not shown) then provides commands to the robot 12 to control movement of portions of the robot 12 including the grasping mechanism (not shown) in order to grasp and move a selected object and avoid potential obstructions.

Teaching and training a robot to autonomously discover and understand an industrial scene and to perform robot work tasks such as extracting randomly arranged objects from a bin is a complex task. Given a 2D RGB (red, green blue) sensor image, the robot 12 can be trained to identify the picking and dropping bins 60 a, 64 a, and obstacles 62 a, 62 b within the scene 50. In addition, a 2D image can be combined with a calibrated 3D camera sensor to generate accurate spatial location of certain recognized objects. In some aspects, a 3D point cloud based scene reconstruction can be time consuming, however some portions of 3D point cloud data can be used reconstruct a scene for robot training in a virtual environment from the point cloud data to reconstruct a virtual 3D scene that can be used to train the robot in real time. The method for determining such robot commands in an autonomous fashion is described in more detail below.

The control method for defining an automated robot path starts from an initial viewpoint of the robot 12. The control method directs the robot 12 to pan the 3D sensor which can be mounted on the tip of the robot gripper 24 in one exemplary form. Next, an initial 3D model of the scene around the robot 12 is reconstructed with 3D sensor data and robot 12 movement information (3D sensor pose, time-stamp, etc.). The initial 3D model of the scene will be analyzed for parameters such as occupancy, missing information, occluded objects, unknown areas, etc. Scene reconstruction is continuously updated during robot 12 operation. Computer processing computation for the scene reconstruction can be done independently and in parallel to robot 12 work tasks such as picking or dropping work tasks. A new scan angle may only be generated if the system cannot recognize an object 42 based on the previously gathered information. New scans and robot 12 move path calculations may or may not be performed solely to complete the scene reconstruction process. The new scan angles are generated based the prior knowledge from the scene understanding. Based on the observed data, a posterior predictive distribution can be calculated and a maximum likelihood estimation of the probability can be used to determine a new view angle that would yield the most useful information to further the understanding of the robot 12.

Referring now to FIG. 3 a flow chart illustrates a control method 100 for generating a scanning path for collision free robot motion according to one embodiment of the present disclosure. The control method 100 begins at step 102 where the robot starts with a predefined 3D scan of a collision free path. At step 104 the robot re-constructs the scene and the environment around the robot with a 3D scanning device. The scanning device will transmit scanned images to a memory such that the control system can then analyze the 3D scene model at step. The control method 100, at step 108 then determines whether the 3D model of the scene around the robot is completed sufficiently for the robot to perform a desired task. If the answer to the query at step 108 is “no,” then the control method 100 will generate the next scanning viewpoint for the 3D scanner to obtain additional images. At step 112, the control method 100 plans the next scanning path with a robot collision free motion planner based on the latest 3D scene model. At step 114, the robot will scan the industrial scene along the next collision free path to obtain scanned images from a different viewpoint. At step 116, the control method 100 generates a complete 3D scene model around the robot. Referring back to step 108, if the answer to the query is “yes,” then the control method 100 moves to step 116 and generates a complete 3D scene model around the robot without processing steps 110, 112 and 114.

Referring now to FIG. 4, a control method 200 is illustrated whereby a robot learns to recognize an object within an industrial scene. The control method 200 starts at step 202 where the robot determines a predefined collision free path with a 3D scanning device. At step 204 the robot reconstructs the scene including the environment around the robot. At step 206 the control method 200 runs an object detection and recognition program. At step 208 a query by the control method 200 causes a determination to be made as to whether the 3D model of the scene is sufficient to detect and recognize the object to the extent required to perform a robot task thereon. If the answer to query 208 is “no,” then the control method 200 at step 210 will generate a next scanning viewpoint to reduce the ambiguity of the object with the detection and recognition program. At step 212, the robot will perform a 3D scan along a new collision free path. Referring back to step 208, if the answer to the query is “yes,” then the control method 200 moves to step 214 where the control method 200 generates the local scene model with the recognized object for the robot to perform a robot task thereon.

Referring now to FIG. 5, a control method 300 is illustrated beginning at step 302 where a robot uses 3D scanning to define a predefined collision free path. At step 304 the control method 300 directs the robot to reconstruct the industrial scene around the robot. The control method 300, at step 306 then uses the object detection and recognition program to analyze the scene construction obtained by the robot and at query 308 the system determines whether the scene is sufficient to affirmatively detect and recognize the object. If the answer to query 308 is “no,” then at step 310 the control method 300 will direct the robot to generate additional scanning viewpoints in order to reduce the ambiguity of the object. A at step 312, the control method 300 plans the next scanning path with the robot collision free motion planner based on the latest 3D scene model. The robot then performs a new 3D scanning path at step 314. The latest 3D scanning on the new path is used to generate a new local scene model and determine the type of object at step 316. Referring back to query 308, if the answer is “yes,” as to whether or not the 3D model was sufficient to detect and recognize the object, then the control method 300 moves down to step 316 so as to permit the robot to perform a robot work task on the recognized object.

Referring now to FIG. 6, a control method of operation 400 is provided for the robot to perform a work task on an object such as picking or grasping. At step 402, the robot obtains a predefined collision free path from a 3D scan. The robot at step 404 then reconstructs the industrial scene around the robot to determine whether an object is detected within the scene. The robot will use the 3D object detection and recognition program at step 406 to determine whether the 3D scene around the robot has a desired object located therein and if so, at step 408 the control method 400 runs an object grasping and positioning analysis to determine whether the 3D model of the scene is sufficient for grasping the object at query 410. If the answer to query 410 is “no,” then at step 412, the control method 400 will generate a next scanning viewpoint to improve the confidence of the grasping analysis. The control method 400 at step 414 will determine a collision free path for the robot to move along so that the vision system can obtain a 3D scan of the environment. At step 416, the robot will perform a work task on the object such as grasping or picking the object after the 3D model is determined to be sufficient to perform such a task. If the 3D model of the scene is sufficient for the robot to perform a work task at 410 then the control method 400 moves to step 416 and the robot is then directed to perform the task on the detected object.

Referring now to FIGS. 7A and 7B, a control method 500 for improving object recognition, improving grasping confidence and planning scanning paths for collision free motion for a robot is illustrated. The control method 500 begins at step 502 where the robot obtains a predefined collision free path from a prior 3D scan of the work environment. At step 504, the robot then reconstructs the industrial scene around the robot and performs a 3D object detection and recognition analysis at step 506. After the object is recognized, the robot will perform an object grasping and positioning analysis at step 508. At query 510, the control method 500 will determine whether the 3D model of the industrial scene is sufficient to detect and recognize the object. If it is not, then at step 512, the control method 500 will generate a new scanning viewpoint to reduce the ambiguity of the object. At step 514, the robot will plan a new path and based on the scanning viewpoints at step 512, the robot will move along the path and produce additional 3D scanning images. The control method 500 then will move back to step 504 and repeat steps 504, 506 and 508 until the scene model is sufficiently complete at query 510. If the 3D model of the scene is sufficient to detect and recognize the object, then at step 516 the object grasping positioning analysis is run once again. A query is performed at step 518 to determine if a 3D model of the industrial scene is sufficient for the grasping analysis to direct the robot to grasp the object. If the answer is “no,” to query 518 then at step 520, the control method 500 will generate new scanning viewpoints and cause the robot to move along a new path at step 522 to provide a new 3D scan at different viewpoints. The control method 500 then loops back to step 504 and repeats steps 504, 506, 508, 510, 516 and 518 until the answer to each of the queries at step 510 and 518 is “yes.” The control method 500 analyzes the 3D scene model at step 524 and determine whether the 3D model of the scene around the robot is complete at query 526. If not, then the control method 500 generates the next scanning viewpoints at step 528, directs the robot to scan a new collision free path at step 530 and then moves back to step 504 to repeat the answer to query 526 is “yes.” At that point the robot is directed to grasp and pick up a detected object or perform other work tasks on the object at step 532.

In one aspect the present disclosure includes a method comprising: determining a predefined collision free robot path; moving a robot along the predefined robot path; scanning an industrial scene with a scanning sensor positioned on a robot while moving along the predefined robot path; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in the memory; planning a next collision free robot path based on the 3D model; moving the robot along the next collision free robot path; scanning an industrial scene with the scanning sensor positioned on the robot while moving along the next robot path; and storing new scanned images in the memory; and reconstructing the 3D model of the industrial scene based on the new scanned images.

In refining aspects, the method further comprising repeating the planning, scanning, storing and reconstructing steps until a completed 3D industrial scene is constructed; further comprising performing a work task with the robot after completing the 3D industrial scene model; wherein the scanning sensor is a 3D camera; further comprising moving the scanning sensor relative to the robot when determining the predefined collision free path; wherein the moving of the scanning sensor includes panning, tilting, rotating and translating movement relative to the robot; wherein the moving of the scanning sensor includes moving an arm of the robot while a base of the robot remains stationary; further comprising planning the collision free path with a controller having a collision free motion planning algorithm; wherein the planning of the collision free path occurs in real time without offline computer analysis.

Another aspect of the present disclosure includes a method comprising: determining a predefined collision free robot path; scanning an industrial scene along the predefined collision free robot path with a scanning sensor positioned on a robot; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in memory; detecting an object within the 3D model of the industrial scene; moving the robot along the collision free robot path to generate a next scanning viewpoint of the detected object; scanning the industrial scene to obtain new scanned images of the object; storing the new scanned images in the memory; and repeating the moving and scanning steps until the object is identified to a threshold certainty level.

In refining aspects of the present disclosure wherein the scanning includes capturing images with a 3D camera; further comprising performing a robot task on the object after the object has been identified to the threshold certainty level; wherein the robot task includes grasping the object; further comprising panning, tilting and rotating the scanning sensor to capture images from different vantage points to generate a new 3D model of the industrial scene; further comprising planning a next scanning path prior to generating the new 3D model of the industrial scene; wherein the planning includes analyzing the new 3D model with a controller having a collision free motion planner algorithm; and further comprising determining the next scanning path based on results from a collision free motion planning algorithm.

Another aspect of the present disclosure includes a method comprising: determining a predefined collision free robot path; scanning an industrial scene proximate a robot with a scanning sensor; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in memory; detecting an object within the industrial scene; determining whether the object is recognized with sufficient precision; determining whether a robot task can be performed on the object; and performing one or more robot tasks on the object after the object is recognized with sufficient certainty.

In refining aspects of the present disclosure the method further comprises generating a next scanning viewpoint and rescanning the industrial scene if the object is not recognized with sufficient certainty; further comprising generating a next scanning viewpoint and rescanning the industrial scene if the 3D model of the industrial scene is not sufficient for grasping analysis; further comprising generating a next scanning viewpoint and rescanning the industrial scene if the 3D model of the industrial scene is not complete; wherein the scanning of the industrial scene includes panning, tilting, rotating and translating the scanning sensor relative to the robot; further comprising planning the collision free path by a controller having a collision free motion planning algorithm; and wherein the planning occurs in real time without offline computer analysis.

While the application has been illustrated and described in detail in the drawings and foregoing description, the same is to be considered as illustrative and not restrictive in character, it being understood that only the preferred embodiments have been shown and described and that all changes and modifications that come within the spirit of the applications are desired to be protected. It should be understood that while the use of words such as preferable, preferably, preferred or more preferred utilized in the description above indicate that the feature so described may be more desirable, it nonetheless may not be necessary and embodiments lacking the same may be contemplated as within the scope of the application, the scope being defined by the claims that follow. In reading the claims, it is intended that when words such as “a,” “an,” “at least one,” or “at least one portion” are used there is no intention to limit the claim to only one item unless specifically stated to the contrary in the claim. When the language “at least a portion” and/or “a portion” is used the item can include a portion and/or the entire item unless specifically stated to the contrary.

Unless specified or limited otherwise, the terms “mounted,” “connected,” “supported,” and “coupled” and variations thereof are used broadly and encompass both direct and indirect mountings, connections, supports, and couplings. Further, “connected” and “coupled” are not restricted to physical or mechanical connections or couplings. 

What is claimed is:
 1. A method comprising: determining a predefined collision free robot path; moving a robot along the predefined robot path; scanning an industrial scene with a scanning sensor positioned on a robot while moving along the predefined robot path; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in the memory; planning a next collision free robot path based on the 3D model; moving the robot along the next collision free robot path; scanning an industrial scene with the scanning sensor positioned on the robot while moving along the next robot path; and storing new scanned images in the memory; and reconstructing the 3D model of the industrial scene based on the new scanned images.
 2. The method of claim 1 further comprising repeating the planning, scanning, storing and reconstructing steps until a completed 3D industrial scene is constructed.
 3. The method of claim 2 further comprising performing a work task with the robot after completing the 3D industrial scene model.
 4. The method of claim 1, wherein the scanning sensor is a 3D camera.
 5. The method of claim 1 further comprising moving the scanning sensor relative to the robot when determining the predefined collision free path.
 6. The method of claim 5, wherein the moving of the scanning sensor includes panning, tilting, rotating and translating movement relative to the robot.
 7. The method of claim 5, wherein the moving of the scanning sensor includes moving an arm of the robot while a base of the robot remains stationary.
 8. The method of claim 1 further comprising planning the collision free path with a controller having a collision free motion planning algorithm.
 9. The method of claim 1, wherein the planning of the collision free path occurs in real time without offline computer analysis.
 10. A method comprising: determining a predefined collision free robot path; scanning an industrial scene along the predefined collision free robot path with a scanning sensor positioned on a robot; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in memory; detecting an object within the 3D model of the industrial scene; moving the robot along the collision free robot path to generate a next scanning viewpoint of the detected object; scanning the industrial scene to obtain new scanned images of the object; storing the new scanned images in the memory; and repeating the moving and scanning steps until the object is identified to a threshold certainty level.
 11. The method of claim 10, wherein the scanning includes capturing images with a 3D camera.
 12. The method of claim 10 further comprising performing a robot task on the object after the object has been identified to the threshold certainty level.
 13. The method of claim 12, wherein the robot task includes grasping the object.
 14. The method of claim 10 further comprising panning, tilting and rotating the scanning sensor to capture images from different vantage points to generate a new 3D model of the industrial scene.
 15. The method of claim 14 further comprising planning a next scanning path prior to generating the new 3D model of the industrial scene.
 16. The method of claim 15, wherein the planning includes analyzing the new 3D model with a controller having a collision free motion planner algorithm.
 17. The method of claim 16 further comprising determining the next scanning path based on results from a collision free motion planning algorithm.
 18. A method comprising: determining a predefined collision free robot path; scanning an industrial scene proximate a robot with a scanning sensor; storing scanned images of the industrial scene in a memory; constructing a 3D model of the industrial scene based on the images stored in memory; detecting an object within the industrial scene; determining whether the object is recognized with sufficient precision; determining whether a robot task can be performed on the object; and performing one or more robot tasks on the object after the object is recognized with sufficient certainty.
 19. The method of claim 18 further comprising generating a next scanning viewpoint and rescanning the industrial scene if the object is not recognized with sufficient certainty.
 20. The method of claim 18 further comprising generating a next scanning viewpoint and rescanning the industrial scene if the 3D model of the industrial scene is not sufficient for grasping analysis.
 21. The method of claim 18 further comprising generating a next scanning viewpoint and rescanning the industrial scene if the 3D model of the industrial scene is not complete.
 22. The method of claim 18, wherein the scanning of the industrial scene includes panning, tilting, rotating and translating the scanning sensor relative to the robot.
 23. The method of claim 18 further comprising planning the collision free path by a controller having a collision free motion planning algorithm.
 24. The method of claim 23, wherein the planning occurs in real time without offline computer analysis. 